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•  An  integrated  modeling  and  simulation  capability  for 
intelligent  vehicles  that  can  model  desired  mobility 
scenarios  of  interest,  on-road  or  off-road,  and  is 

-  High  fidelity 

-  Fast 

-  Scalable 

-  Flexible 

-  Adaptable 

-  Helps  enhance  mobility 

>  i.e.,  goes  faster  and  farther 

•  Funding:  $50K 
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Teleop  to  Autonomous  Robotics 


Vozar,  S.  and  Tilbury,  D.  M.,  “A  System-Level  Methodology  for  Design  TECHNOLOGY  DRl  WARFIGHTER  FOCUSED. 

Optimization  of  Teleoperated  Mobile  Robot  Speeds,”  ARC  Project.  UNCLASSIFIED 


Teleop  to  Fully  Autonomous  Vehicle  M&S 
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Teleop. 
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U  :  Control  Signal:  Steer  Angle,  Braking  Pressure,  Throttle  Angle 
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RDEGOM  "intelligent  Vehicle  Mobility  Roadma 


KO:  1.1.1, 1.1.4 


Model-Based  Development  of 
Mobility  vs.  Latency  vs.  Autonomy  Relation 


Mobility  Scenarios 
Selection 


Mobility  Metric  Selection 


Dynamic  Model  Fidelity 
Decision _ 


Dynamics  Solver 
Selection 


Terramechanics 
Approach  Development 


Compute  Power 

Selection 

ARLTPA 

Simulate  Mobility  Events 
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Communication  Network 
Selection  DSD  SBIR 


Identify  Delays  and 
Bandwidth  Issues 


Implement  Delays 


Simulate  Mobility  Events 
for  Various  Delays 


TARDEC 


Analyze  Effect  of  Delays 


Mitigate  Effect  of  Delays 


Platform  Mobility  tardec 

Communication 

Autonomy 

Select  Framework  for  Shared 
Control  MIT 


Control  Algorithm  Selectioi  DM 


User  Cognitive  Model 
Selection 


Identify  Delays 


TECHNOLOGY  L 


Determine  Autonomy  & 
Latency  Relationship  to 
Maximize  Mobility 


TARDEC 


Sensor  and  Perception 
Algorithm  Selection 


Simulate  Mobility  Events  for 
Levels  of  Autonomy  TARDEC 


Vehicle  mobility  is  mainly  a  function  of 
the  vehicle  mechanical  platform 
irrespective  of  whether  manned  or 
unmanned. 
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Pre-Defined  Path  vs.  Autonomous 


•  Predefined  path 

-  Detailed  track  model 

-  Predefined  avoidance 
path 

•  High-Fidelity 

-  Detailed  track  model 

-  Autonomous  operation 

•  Simplified 

-  Simplified  wheel  model 

-  Autonomous  operation 

•  Co-simulation  of  RecurDyn, 
PreScan,  and  Simulink 
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Operation 
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Z-Position  [m] 


Simulation  Comparison 


•  Trajectory  differences  based  on  simulation  type 


Path  from  Overhead 
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Simulation  Comparison 


•  Motor  torque  differences  based  on  simulation  type 


Motor  Torque 


•  Average  power  requirements  (W) 

-  High  Fidelity:  86.4  Simplified:  42.8  Predefined:  27.6 
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Robotic  simulations  look  cool  and 
realistic  so  they  must  be  real. 
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RDECOM 


Autonomous  Navigation 


-a. 


Virtual  Environment  Laboratory  (ANVEL) 


Developed  for  ERDC  since  2007 

-  Original  intent:  real-time,  desktop  “front  end”  to  support  high- 
fidelity,  off-line  HPC-based  simulations  in  VANE 

-  Evolved  into  desktop  UGV  simulation  package 

Modular,  flexible  simulation  tool  and  easy-to-use 
environment 

-  Real-time  interactivity 

-  Ability  to  incorporate  models  and  code  and  customize 

-  Import  and  drag-and-drop  build  environments 

-  Instrument,  record,  and  export  data 

Developed  by  Quantum  Signal  in  Saline,  Michigan 


No-cost  government  and  academic  versions 

-  All  source  code  available  to  government 
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ANVEL  Vehicles  by  Quantum  Signal 
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RDECOM  i  Rover  Analysis,  Modeling,  and  Simulation  /A 

(ROAMS)  S 


•  The  JPL  DARTS  lab  team  has  been  involved  in  vehicle 
modeling  and  simulation  for  over  20  years 

•  Many  key  JPL/NASA  missions  require  high-fidelity 
simulations 

-  Spacecraft  missions  (Cassini,  MER,  MSL) 

-  Planetary  rovers  (Pathfinder,  MER,  MSL,  research 
rovers) 

•  The  DARTS  lab  team  created  ROAMS  for  vehicle 
simulations  of  planetary  rovers 
(http://dartslab.jpl.nasa.gov) 
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ROAMS  Vehicles  by  NASA  JPL 


Platform  Mobility 


■  Vehicle  Modeling 

■  Terrain  interaction 

■  Physics  Engine 

■  Scenario  Development 


Hardware  /  Software 


■  Compute  Power 

■  Visualization 
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Attributes 


Autonomy 


■  Sensor  Models 

■  Control  Algorithm 

■  User  Cognitive  Model 

■  Shared  Control  Framework 
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Benchmark:  Vehicle  Modeling 


Benchmark  Feature 

ANVEL 

ROAMS 

Wheel  Vehicle  Modeling 

Simplified 

Yes 

Tracked  Vehicle  Modeling 

No 

No 

Suspension  Modeling 

Simplified 

Detailed 

Tire  Modeling 

Rigid  Wheel/Tire 

Pacejka  Slip  Model 

Rigid  Wheel/Tire 

Kinematic  Joint  Modeling 

Limited:  4  Joint  Types 

Larger  Library:  10+  Joints 

Internal  Force  Modeling 

Limited:  Linear  Spring/ 
Damper 

Linear  &  Nonlinear  Spring/ 
Damper 

Collision  Detection 

Uses  OpenDE 

Uses  Bullet 

Contact  Modeling 

Hard  Contacts:  Constraints 

Hard  Contacts:  Constraints 
Soft  Contacts:  Penalty 

Scalability 

No:  0(N3) 

Yes:  O(N) 
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Suspension  Modeling  Differences  x  ^ 


ANVEL:  Simplified 


■  Only  vertical  suspension 
motion 


ROAMS:  Realistic 


■  Detailed  suspension  model 
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Compute  Cost  vs.  Problem  Size 


Comparison  of  Algorithm  Order  &  Cost 


UNCLASSIFIED 


TECHNOLOGY  DRIVEN.  WARFIGHTER  FOCUSED. 


Benchmark:  Terrain  Interaction 


Benchmark  Feature 

ANVEL 

ROAMS 

On-Road  Terrain 
(Rigid) 

Uses  OpenDE  Hard  Contacts 
Pacejka  Slip  Model 

N/A  for  Planetary 

Missions 

Off- Road  Terrain 
(Deformable) 

Bekker  and  Janosi-Hanamoto 
ERDC  GCE  Model 

Fn:  Hunt-Crossley  Model 
Ft:  Mohr-Coulomb  Model 

Benchmark:  Scenario  Development 


Benchmark  Feature 

ANVEL 

ROAMS 

Urban 

Native  or  Import 

City  Engine  Import 

Off  Road 

Native  or  Import 

Surface  Height  Map  & 
Textures  Import 
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Benchmark:  Physics  Engine 


Benchmark 

Feature 

ANVEL 

ROAMS 

Formulation 

“Open  Dynamics  Engine”  (OpenDE) 
Newton-Euler  Equations 

Lagrange  Multiplier  Constraints 

DAE  0(N3)  Interactive  Solver 

Minimal  Coordinates;  Recursive;  DE; 
O(N);  Constraint  Embedding  for 
Loops;  Spatial  Operator  Algebra  - 
No  Mass  Matrix  Inversion 

Integrator 

Euler  Algorithm 

Explicit:  Conditionally  Stable 

CVODE  from  Lawrence  Livermore 
Adams-Moulton  Implicit  Algorithm  for 
Non-Stiff  Systems,  BDF  Implicit  for 
Stiff  Systems:  Unconditionally 

Stable 

Integration  Order 

1 

Variable:  1-5  for  Stiff  Systems 

1-12  for  Non-Stiff 

Integration  Step 

Size 

Fixed 

Variable 

Simulation  Fidelity 

Low:  Good  Enough  for  Gaming 

Not  Accurate  for  Engineering 

High:  Required  for  NASA 
applications 

Simulation  Speed 
Expected 

Real  Time 

Real  Time 

TECHNOLOGY  DRIVEN.  WARFIGHTER  FOCUSED. 

UNCLASSIFIED 


ANVEL:  Euler  Integrator 


Accuracy 


Stability 


Blue:  Exact  solution 
Red:  Euler  method 


Black:  Exact  solution  of  y’  =  -  2.3  y 
Blue:  Euler  method,  step  size  =  1 
Red:  Euler  method,  step  size  =  0.7 
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ANVEL 


UNCLASSIFIED 


Benchmark:  Autonomy 


Benchmark  Feature 

ANVEL 

ROAMS 

Sensors 

LIDAR,  IMU,  GPS,  Camera 

LIDAR,  IMU,  GPS,  Camera, 
Wheel  Encoders 

Control  Algorithm 

Native  Solution  (PID?) 

Open  Loop 

Closed  Loop:  PID 

Obstacle  Avoidance 

No 

No 

Dynamic  Stability 

No 

No 

User  Cognitive  Model 

No 

No 

Shared  Control 

Joystick  Interface:  Yes 

M&S:  No 

Joystick  Interface:  Yes 

M&S:  No 
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Benchmark:  Hardware  /  Software 


Benchmark  Feature 

ANVEL 

ROAMS 

Compute  Power 

Desktop 

Desktop 

OS 

Linux,  Windows 

Linux 

Ease  of  Use 

GUI 

GUI 

Language 

C++  and  XML 

C++  and  Python 

Usage  Rights 

Government  Rights 

Government  Owned 

Maintenance 

Contractor 

Government 

Benchmark:  Visualization 

Benchmark  Feature 

ANVEL 

ROAMS 

Geometry  Import 

OBJ,  3DS,  OGRE  Mesh  Formats 

Vehicle:  Most  CAD  Formats 
Terrain:  Most  DEM  and  Mesh 

Rendering  Engine 

OGRE 

OGRE  and  GPU  Shader 
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Mobility  Scenarios  of  Interest 


0  100  200  300  400  500 

x(m) 


Urban  Navigation 


Double  Lane  Change 


Off-Road  Mobility 
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NATO  Double  Lane  Change 

Maneuver 
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This  procedure  is  NATO  m  ®  m 

AVTP  03-1 60W,  also  SAE  f 

J2014  I  W2 


Ml 

-  l.l(VU) 

♦  0.25m 

W  2 

■  1. 2  (VU) 

+  0.25m 

VW 

■  Vehicle 

Width 

Leff  =  Overall  Length  of  the  Vehicle  Measured  at  0.5»  froir  the  Ground 


NATO  Lane  Change  Test  Course  with  Cones 
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Vehicle  Path  vs.  NATO  Course 


ADAMS 


ROAMS 


ANVEL 
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Tire  Normal  Force  @  Front 


ADAMS 


ROAMS 


ANVEL 
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ADAMS 


ROAMS 


ANVEL 
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Lateral  Acceleration 


ADAMS 


ROAMS 


ANVEL 
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ADAMS 


ROAMS 


ANVEL 
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ADAMS 


ROAMS 


ANVEL 
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Response 


co  ^ 

O  O) 

m  00 
<  CD 

>  O 
CD  o 


Left  Front 


Right  Front 


Left  Rear 


Right  Rear 


Lateral  Acceleration 

(g) 


Body  Roll  Angle 
(deg) 


Body  Roll  Rate 
(deg/s) 


CPU  Time  per 
Simulation  Time 
(s/s) 


ADAMS 


Max 


1.5 


1.5 


1.8 


1.7 


0.5 


4.1 


16.0 


Min 


0.5 


0.5 


0.3 


0.2 


-0.5 


-3.7 


-17.8 


8.8a 


ROAMS 


Max 


1.6 


1.6 


1.7 


1.7 


0.6 


4.8 


13.2 


Min 


0.5 


0.5 


0.1 


0.1 


-0.6 


-4.8 


-14.4 


3.4C 


a:  ADAMS  simulated  with  a  maximum  step  size  of  0.001  sec  (variable  step  size  integrator);  Error  tolerance  0.01 

b:  ANVEL  is  capable  of  real  time  simulation,  however,  with  the  default  step  size  of  0.01  sec,  the  simulation  was  unstable  and  crashed.  Step  size  reduced  to  0.001  sec 
c:  ROAMS  simulated  with  the  default  maximum  step  size  of  0.01  sec  (variable  step  size  integrator);  Error  tolerances:  rel  10'4,  absMVEN.  WARFIGHTER  FOCUSED. 
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Summary  Results 


•  M&S  Features 

-  ANVEL  offers  intuitive  user  interface  and  is  easy  to  generate  models,  but 
lacks  necessary  modeling  components  for  accurate  vehicle  dynamic 
modeling 

-  ROAMS  offers  all  necessary  modeling  components  and  can  model 
suspensions 

•  M&S  Capabilities 

-  ANVEL  has  an  unstable  and  inaccurate  dynamics  solver  which  was  not 
designed  for  engineering  applications 

-  ROAMS  has  an  advanced  dynamics  solver  that  is  inherently  stable, 
accurate,  and  efficient  for  near  real  time  applications 

-  Both  software  lack  high  speed  obstacle  avoidance  algorithm 

-  ADAMS  is  an  off-line  (non  real-time)  high  fidelity  mobility  M&S  tool,  the 
gold  standard  to  compare  to 
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Conclusions 


❖  Transition 

-  Both  ANVEL  and  ROAMS  have  been  transitioned  to  TARDEC  including 
source  code 

❖  Recommendation 

-  NASA  JPL  software  ROAMS  is  recommended  for  further  consideration 
as  UGV  Mobility  M&S  tool  for  TARDEC 

❖  Current  Development  /  Next  Steps 

-  Develop  and  integrate  within  ROAMS  (JPL  and  TARDEC) 

>  Human  cognitive  model  (TARDEC) 

>  High  speed  obstacle  avoidance  algorithm  (UM/ARC) 

>  Shared  control  algorithm  (MIT) 

>  Terramechanics  model  (TARDEC) 

-  Advanced  training  in  ROAMS  software 

-  Develop  templates  for  suspensions,  terrains,  scenarios,  etc. 

-  Investigate  effect  of  latency  and  autonomy  on  mobility 

-  Understand  Extreme  Mobility 
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